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Robotic Mobility in dynamic environments has gained popularity among many researchers over past few years. The mechanical 
stability criteria of intelligent robots like two wheeled self-balancing mobile manipulators have become an important subject of 
research in recent time. The balancing on two wheels and spin on the spot ability with smaller footprints of the two wheeled mobile 
robots distinguish them from other multi-wheel counterparts. It is highly essential for stabilizing the robot's body posture and 
trajectory control during navigation in a clumsy environment. Hence the present work analyses the exact dynamics of the 
mechanisms involved, using governing equations of motion for further design and implementation. The necessary sensory 
informations about the tilt angle are obtained from both accelerometer and gyroscope collectively. Finally the dynamic system 


modeling is mathematically established through both DC motor electrical model and two wheeled inverted cart model. 
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1. INTRODUCTION 


The invention of machine tools in nineteenth century and subsequent development of computers in twentieth century provide the 
technology to build facsimiles of the brain and body parts of different creatures in the form of robots. Basically, these robots are 
initially employed at monotonous and repetitive works inside industries to accelerate productivity. The first articulated robot concept 
was brought forward by George Devol in 1960. Initially the industrial robots or else named as manipulators are having fixed base 
and are taught to perform some sequential tasks in a confined workspace. In due time fusion of sensors facilitate independent data 
acquisition from the environment and subsequent implementation of different artificial techniques make them more autonomous in 
nature. 

Now a days due to technological advancement the use of robots are not confined only in industrial organizations; rather their 
involvement spread out to many domestic purpose fulfillment like assisting human beings in their normal routine activities in both 
home and offices. For performing such kind of task the robots must be quite intelligent and autonomous in nature so that it can 
work independently in an environment quite similar to practical situations like flat surfaces, slopes, sharp turns, steps as well as 
narrow spaces. Hence, the present work describes about a two wheeled mobile manipulator, which is a combined system of an 
inverted pendulum, manipulator, and mobile platform. The advantage of this fusion lie upon the dynamic stability feature of the 
inverted pendulum, which actively stabilizes itself even the system is quite tall. Unlike conventional manipulators engaged in 
industries with fixed base are having limited workspace but by combining this wheeled mobile platform with manipulators the work 
space increases. Therefore, the two-wheeled mobile manipulators (as in figure 1,2) show an excellent maneuverability in confined 
space with smaller footprints and more flexibility than statically stable multi wheel robots. The inherent dynamic stability concept is 
described mathematically by considering both DC motor electrical model and inverted cart model. 


Figure 1 Solid Modelling of Two Wheeled Mobile Manipulator Figure 2 Lab Built Two Wheeled Mobile Manipulator 


Deegan et al. [1] assessed the UMASS uBot-4, which is a dynamically stable two-wheeled mobile manipulator, and they 
motivated for its advanced design. This series of the robot have the platform for whole body postural control relevant to the force to 
be render at manipulator end-effecter. Ren et al. [2] developed a dynamical model for the motion of two-wheeled Vehicle which is 
intrinsically unstable. Due to the nonlinearity of mathematical model Neural-Network like self tunning PID control is proposed for 
controlling parameters automatically.. Abeygunawardhana et al. [3] developed a real-time Gain Control Technique for improving the 
stability of two-wheel mobile manipulator. The kinematic and dynamic model for a coaxial two-wheeled system mounted with three- 
link manipulator was established. The proposed Control Technique improved the performance of robot by varying the proportional 
and velocity gains during trajectory control loop and balancing loop. Stilman et al. [4] successfully developed and designed a novel 
humanoid torso named Golem Krang at Georgia Institute of Technology, Atlanta, Georgia, in the United States, which is capable of 
accessing the position in a constrained space in both static and dynamic mode. Golem krang resembles the dynamically stable two- 
wheel mobile robot attached with the manipulator. 

Abeygunawardhana et al. [5] conducted simulation analysis and experiment to obtain high performance of stability in the two- 
wheel mobile manipulator. They succeeded to stabilize the posture of the two-wheel mobile manipulator by combining sliding 
mode controller using a twisting algorithm with disturbance observer. Ahmad et al. [6] established the mathematical dynamic model 
double-link two-wheeled mobile robot, which is a highly complex non-linear system. Hybrid fuzzy-PD type control system was 
implemented to control the links attached to the robot during dynamic stability simulation and proved the better performance prior 
to conventional PID controller. An et al. [7] developed mechanical structure and dynamic models by using energy conservation 
principle and implemented both Linear-quadratic regulator and proportional-integral-derivative control system for self-balancing 
and yaw rotation. 
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2. Dynamic system modelling 

Here the dynamics of the robot is described by a mathematical model in order to facilitate the development of an efficient control 
system for balancing it. In this section, the linear model of a DC motor and equation of motion for a two-wheeled inverted 
pendulum is derived in detail. First of all a state space model for the DC motor is represented by considering the position and 
velocity as parameters. This model provides a relation between the input voltage to the motors and the control torque needed to 
balance the robot as shown in figure 3. 


2.1. Linear Model of a DC Motor 
Let V, =applied voltage ,i =current, K,, = torque constant, V, =back e.m.f,7,, = motor torque produced , K, = back e.m.f 


constant, R = Resistance, - = initial load of armature, 7, = applied torque , K, = Frictional constant ,@= angular velocity of 


the shaft. 


Figure 3 Linear model of a DC Motor 


From basics of DC motor calculations we can write 


V,-V, =iR (1) 
In addition, as V, is proportional to rotation velocity of shaft and motor torque produced is proportional to current 
V, = KO, =Kyi 2) 
V,—K,@=iR (3) 
. “hat 
i=——+—YV, (4) 
R R 
From the dynamics of motor and assuming motor inductance and motor friction to be negligible we can write 
do 

te te GO (5) 
do K,i tT 

=a (6) 
dt Ip Tp 


From equation (4) and (6) 

do —K,.K,,o. K,, a 
— = — 5 typ -- (7) 
a ik “ik” 


Hence, from the above equation the motor dynamics can be represented by following state space model. 


., [0 1 0 0 
@Q 0 Va 
. = O —K,, K, + K,, 7 L 


Ou 1,R T,R I, |e“ 


2.2. Dynamic Model of Two-Wheeled Cart 

Let T,,T, = applied torque from left and right motors, 

W,.R,_.Wp,Rp = the reaction forces between wheels and chassis, 

F’,, Fp = frictional force between ground and wheels, M_,,, = Mass of wheel, /,,, = inertia of wheel, 7 = radius of wheel, 


r*w 
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6, = Rotation of wheel as shown in figure 4, 5. 


0 


‘ WwW 


ae 


W,+We 


Figure 4 Free Body Diagram of wheel Figure 5 Free Body Diagram of Cart 


For the wheel to be dynamically stable, we can write by applying Newton's law 
LF =M, in xX direction 


ax 

M,, — = F, —R,, (For left Wheel) 
dt 

And the moment about point ‘O’ 


2 
2M, =I, en =T, -F,r (9) 


Form DC motor dynamics 


_7, ~—KnK.( dOw), Kany (11) 
se R dt 


Putting in equation (2) 


2 
I, d Ow = K,,K. (+ Kia F,r (12) 
dat R dt 


F., = —t,, d e 0, K., K, d 6, | KV (1 3) 
? r dt” Rr dt 


Since linear and angular motion is acting on the centre of wheel 
do, d°x1 dO, dx 1 
oo Tk a 
dt dt" r dt dtr 
I, d°x K,,K, dx is Aes 
r’ dt? Rr? dt — Rr 
Similarly for right wheel 


f= 
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I, d°x K,K, dx K,V, 
ae ee 5 + (16) 
r° at Rr° at Rr 
Adding (15) and (16) 
21 d’x  2K_K, 2K,, 
F,+Fp=-— a ; cate (17) 
r-. dt? Rr a Rr 


Adding both equation and substituting the value of F, + Fp from equation (17) 


I, a 2K Ke dx | 2K,,V,, 


Rr + Ry =— My + ol 2 dt Rr’ di" Rr a 


Let M, be mass of pendulum concentrated on point P of the pendulum at a distance |, 6, is the angle tilt. 


Using Newton's Law for dynamic stability 


2 
d°x 
t 
(Sn ete apg 2) yp 22 (20) 
(RL +Rp)-M, 7 08 | eM - =M,—2 
ax a a (21) 
(R, +R.) M, Pe +M ,l P cosO ual s) sin 0 
d°o 
xT, =1, + (22) 
Bb P dt 
do, 
(W, +W, )isin@, —(R, + Rp )lcos 0, —(T, +Tp) =1, . —- 
t 
(23) 
Since (eG +Trp) _| ~KnKe dx + Kin V, |x2 i.e the torque applied on pendulum from motor. 
Rr at R | 
(24) 
The sums of forces perpendicular to the pendulum are 
XF,, =M ,xcos@, (25) 
(R, +R, )cos0, +(W, +Wp)sind, —M,g sind, -M,]6, = M ,Xcos@, (26) 
Multiplying (26) by -/ and adding with equation (23) 
ao, 40, d°x 27 
-(T, +T,)=M gl sind, + M I 73 +I, WF +M , 7 cos6,, (27) 
From (24) 
do, dO : 
ais ae 2K Va _ pgisind, +M ,I—F +1, ae ey | (28) 
Rr dt  R de * de? Pde? 
ao 2 2 
(1, +M,I’) £ aK (S) 42K nVe 4 pgisind, =—-M mit> ~ cos, 2) 
Ed ae Rr \dt R Pde! 
2K WV -(2, +2 +M joe - 4 2KnkKe Bi 4% cos@,-M 10,” sind (30) 
Rr r dt’ Rr dt ” dt’ s ven f 
The two non-linear equations of motion of the system can be rearranged as, 
2) 2KmKe ., 2Kmy 4 nO = 31 
(1, +, )6, or 7 V,+M_,glsin@, =M ,lcosé, (31) 
PB ys -(2m, +See » je qn X+M, 16, cos 8, -M IG, sind, ee) 
Rr Rr? 
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The above two equations can be linearised by assuming a, =1+¢o 


2 
| d0, 

@ is very small angle, Cos 6, =-—l,sin 6, =-¢, ae =0 
The linearised equation of motion is 

, 2K,K. . 2K, 33 

2 m**e m ey 
(1,+M,07)¢ at i+ BV, —M 816 = M hi (33) 
ay, = 2M,, + 748 +M, x+7Kuke su ig (34) 
Rr r : Rr : 
0 1 0 0 0 Je 

é ; 2K,,K,(Mlr-1,-M,l°) M2eI all? 2K,,(1,+M,I° -M Ir) ey) 
x - Rra a x rd Rra V 
| 0 0 0 I¢ 0 ‘ 
9 ' 2K,,K,(rB-M |) Msp ¢ 2K,,(M,!-rB) 

Rra a Rra 


I 
where —| 2M, + 74M, 1a | 1,6+2M 2 (m,, +2) 
r r 


3. DISCUSSIONS 

In the above analysis, the linear state space representation of angular velocity and angular acceleration of DC motor model has been 
established considering various parameters like motor torque, applied voltage, inertial load on armature and motor resistance. 
Similarly a dynamic model for a two wheeled manipulator is being formulated considering both force and moment equations on 
wheel as well as cart. This corresponds to final state space equation representing cart’s linear along with angular velocity and 
acceleration. 


4. CONCLUSIONS 

The two-wheeled mobile manipulators show an excellent maneuverability in confined space with smaller footprints and more 
flexibility than statically stable multi wheel counter parts. These are differential drive robots consisting of two wheels on a common 
axis and each wheel driving independently. Such arrangement gives the robot the ability to drive straight, turn in narrow place and 
move in arc. But sometimes the errors coming from the wheel site, friction between the wheels and contact surface deviate the 
robot from its intended course. Due to its nonlinear and unstable system dynamics it is really a challenging task to design a suitable 
control system for a two wheeled balancing robot. As the complete state of the system cannot be fully measured often, hence it is 
essential to derive the linear state space controllers utilizing the dynamic model. Hence in this current research is emphasized on 
mathematical establishment of dynamic system modelling through space representation. Also as the system is inherently unstable, 
suitable design of some efficient controller for stabilizing the robot is taken as future aspect. 
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